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(54) METHOD AND DEVICE FOR POSITIONING OBJECT 

(57)Abstract: 

PROBLEM TO BE SOLVED: To provide a method and 
device for positioning object by which the characteristic 
amount of an object can be detected stably in a short 
time and the object can be easily correlated with a 
reference model from the aspect of the processing 
quantity of information. 

SOLUTION: At the time of positioning an object with a 
manipulator 1 equipped with a sensor 3 which measures 
the characteristic part of an object as a sensor 
characteristic amount, the movement of the manipulator 
1 is monitored through a motion controller 2, a counter 
board 8, and personal computer PC1 and the position 
and posture of the object is estimated by means of 
another personal computer PC2 based on the movement 
information of the manipulator 1. 



..... j «H '? * 



6 



t 



( 



(19>B*B4$fWr (JP) 



«2) & BB 45 K= £t « (a) 



#^¥10-89943 

(43) ^MB ¥^10^(1998) 4 8 10 B 



(51)Int.Cl. 6 
GO IB 21/00 

B2 5J 9/10 
13/08 

GO IB 21/22 



F I 

G 0 1 B 21/00 



A 
B 
A 
Z 



B 2 5 J 9/10 
13/08 
G 0 1 B 21/22 

ssewsr m&mvmi ol (£12 k> 



(21)fii«#*» 


4$IS¥8 -246729 


(71) ffilgA 


000004226 














(22)asH 


¥f£ 8 ¥(1996) 9)1180 




JlOKiBSr iKSiUHT B 19# 2 -if 








(72)»W# 












*^P»f«BgS»f^=T B 19# 2 ^ 


a* 
















(72)%K« 


«*i Hi* 










MSMKSSi^HT 1 19# 2 ^ 


0* 
















(72)%^ 












■%j$mmmmmm=T b i9# 2 ^ 


a* 
















(74)ftSA 


im± m mm 















(54) m&w&m mft&mtkibjimxtmm. 
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S&#>£fT-5lCl!itK V-tfiU— ^ lCDjUfr*^ — 

3>3>FD-72, H 8, MV3>PC 

l®XMflMR£S^T'W:3>PC2£Ttt 




1 

StJgB-b > it tc J; £ ftttffijR k tuIB v = t a 1/ - * ©»Kj 
[»*JH 2 ] BuIB-b >im«»;Ju 

z t*ftmt-r zmmn 1 iztzmom&GLmvt&is&o 

[»*JR 3 ] MIB-b >^ant 
BuiBiilRl^'J^-^ Lfc-fe >imS»©fit*>?> L 

c t znmt-r sat 2 t:EttcD»<«s«st»»ai. 

[11*11 5 ] hubB^H*©^ ^©EffijSfcJu 

t)^©as^*^-r5> 

c i: *«r«i: f 4 Jcg3*©«*:GtBi*«>^«o 

MBB-b > it i: iu IB v ;tfai/-^ gjft^iftflF "T 4 3 t 

t- <t t) , B»i3-fe >t(cTii qjfgT-s aajiB-b 

7 ] mJSB-fe 

c i: *««i:-r 4 if *JS 5 xtt 6 t|3flR©^teS^«) 

8 ] fulBgl 1 ©«««», 
huIBv - hTa. ©8ta«t«#t S, 

7 fcBB«© 

9 ] HUSB-b >imf*«{§ifigtt, 
^$nfeMI3^©ttiS©^^, £ttiNj&£PI&© 
M/^M^A s ^nT-*SF^«©»*^i:©¥«SI»*fiJffl 

S§ 2 (Drnmstt LT^tB^ns, 

[isarji 1 0 ] mmwmmt, 
bis, Mil, »R*a-r#sc»fcj;oT««$n*x 
z t ttftmt-tztmm 9 tci3«©sB«E©^te^^to 



(2) 0-8 9 9 4 3 

2 

[11*11 1 1 ] mmm 2 <ommmt, 
ztzftmtt zmxm9x.it 1 0 £i5tt©gB«©tttt 

[»*JI 1 2 ] MsB»3Mafcfc, 

10 Cfc*«r«i:-r-&W*«9, 1 0 Xtt 1 1 t!3»©«J» 

[fi*H 1 3 ] MIBIg 2 ©«iif «t±. 
□ h©B583^t^1-4T7-D-^ggg|jo«tUfT7- 
3k£^(i;-f 2>il*iI9, 10, HXttl2CB« 

[M*JI 1 4] f&ffi-fe >im, 

20 1> 2, 3> 4, 5, 6, 7, 8 , 9s 10, 11, 1 
2X.lt 1 3 £E«©*B<ttft«i*tf>»iS« 
[W*ill 5] mjS3v^hfiU-^fflJi»jt»$gtt, 
#W«S©:c>:3-^***«Ha5fctiMBC*«*U 

3, 

Ck*»ti:tS««flU 2, 3, 4, 5, 6, 7, 
8, 9, 10, 11, 12, 1 3 Xlt 1 4 lCtBtt©M*: 

[fltJftg 1 6 ] BuBBiz >-y-«f«»tt, 

hfi u— **5fcffiBS?IMlt*K: «fc OI6«ffi««tSS** 

d fc^^hf 4»*IB 1 5 (clB*©t)«:{SS^to^ 

^i^v^trii^-^©$fe4S(c^*^n, mvdmfo*m& 

tl.A> Hi:, 

40 BuIB-b^itC J;3ftiiJ*SJil£!u!Bv- Ka u-^©Sii 
««fca-^«r^TffIIB«J#:©(fi[BiB»*«l«-rsW-Jf« 

1 8 ] mtmmm.it, 

mliB-fe > it t m 13-7 - ^ i b - * k fttt^SWPf 4 c: i: 
tctD, HUlB-lr>ittTa^bTtfei±Jwrt6-cfe4Bfil3-fe 
Vit^S^m^k^ofe^, ngttB?)IBb:>ittX 
*W^ffi7J * o fc tulB-b >-9-«fa« A s ^f±5 Rltgk fc o fc 
^&M83^©^k Ut^b, iulB^ftOffiMg^ 
50 S«s£-f 4«IWMe*tf1-*, 




3 

So 

im*m i 9 ] mmnmit. 
[w*«2 o] mmtmmz. 

-T*ai#2ll 7, 1 9£83«©*9 

[HtsRJf 2 1] mif3-fe>-9-tts 
U— if— U >1tT?&5, 

Zt*¥fWLtir&m&mi 7, 18, 1 9Xf±2 0 lc§B 
[0 0 0 1] 

[«WO«-r«atl5«-B] #3*0J3J;t, FA (factory au 
tomation) #g fciJtt SSnx^flitS: ifCMW bt£Z<M 

i*<DtfLWgm&mf£Tz®i*<DtiLwmisbj5mj8i vm m \z 

o 

[0 0 0 2] 

[&*©&«] ^B©«^#*fc*tt*imi^ia:fcf£3B 

5„ L*»U ^©cfcd&otfy b :>;*^A©#< tt:^ 
[0 0 0 3] A>A>-5HH£ji¥i*-f 3fc#>, iifi^CDtfy 

h^^^Atctt, -b>-y-t:Ti»<*:*iat6w-sibx ^wm 

[0 0 0 4] tzm, 3&7&®><*<DtiLSig&<Dm7£lZ 
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[0 0 0 5] C©t£»)i£fcfc, gHffl®ttftfti*£tttt»£ 
ISW b * fflRW * SI* 1" * c i: t: J; •) * tun -r * t 

jFBHiTJ # £ & i:*©fij^ Plffl 
io ^©fccfctBTOix, 

[0 0 0 6] LfrU RBfeixfcaBLfr^fcJStv^^-y- 
fcTW*«I(*:O^Eg*lI«*-aEt:«l»-r*C:i:tt-lia! 

t; ^ K> W- flt M 1*1 fcf^j* LtiJ^fetltf^i:©?'^ 

20 

[0 0 0 7] 

tit l * 5 £5£ffl -b > 1f©*I§5« fe 3b»«»-h»T? $> 

aj» r 4 fc » n tt-fe > -y- 1: <t s mmwn? t #>*&b$f^ * 

»-£-f d>:>g#& P^It-^ -5c 

[0008] yuzs *>i'>tn,xmtzWWLmmi}>e>m 

& vxDmmvm. \z s % ft <p a^s t o a ihh*** 
[0009] got, ^©^^y^if^ttai^tifc 

[0 0 10] £CC:BVvT*»W«>J!Ptt-*v<*±**l 
Wtt, ^©Jil9T-$)-5)c *»ilO@Wliv MB#P^ 

tz HbOgiW. A, i: "f 5 * © f & -5 o 

[0 0 11] *»W©SB2 0B(Kjtt, «J#©«a**ffl 

50 ofe(a«g»©«^«*©««ii4*»^-r«c kt«t 



(4) 
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[0 0 12] *%WO*:<Di'&<D&m±, B^S, IHH, 
[0 0 13] 

ieiBiTSHewfc«i*MDW««©tftm#-r titf^ 

<fc*K liulB gift So 

[0014] ir&*)*>, *»flB*»OSB 1 ©«f«8\ 4» 

m ufc tr a. u— * ict ^^#3^©teM?*to^ff a tc 

St)> «9E-b>t>-fc«tStl-SiJ*gjRfc«ffiBv = e3.U-^ 20 
[0015] #$gBJ3£?£©Sii 2 ©waii, HiraB3MSflli# 

mum-r z> z 1 1 «fc t> em bTfesaftfii^fesa© 

[0016] #*«3*a:©36 3 CD«r«fct, ifjl3*%B^^ 
^U^-^(C«c#Lfe-te>-9-^S©ffi*5> L^5:*t) 30 

[0017] *&W%m<D?g 4 ©^gfctt, if)I3*^B^^ 

S**, tulBW*©3i^y©Bffl^(c J; !3|?.|^^tiT*S 

[0018] *^B^^^©^ 5 ©«r«fck % 
©fg 4 (DtmiZ 33 W- 4 ffj IB ftflc© a y ©S ft jft A 5 , 

\z&2>o 40 
[0019] *«|8*ffiojB 6 ©ifSmtes HMB#$S9i;& 
ffi©^5©^t*3W?>miBB^*©4S^©^^ iuaB 
-fe>-y-i:B5HBvnf z-V-* t*ffi.&8ktt1-Z>Z£lz& 
t), m)IB^>-9-{CTiil«bT^mRltgT*fe^.MIB-b>-9- 
«Fa***tfttB^FfiB £ o fej£u gEttSuIBHr >*Cttttt 
^# 6"C * o fe auBB-b W«* A s ^tH Wt t f&^tc&t 

[0 0 2 0] #$gBJ!£i£©jg 7 ©£f«Hu tuBB*^^ 
iuHB-7-f jLiy-^CDa»fl9IBtat3i^T, mfaB^I 50 
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^©4jg^©#^©«t^ & b£ *«-r* i ©fins i: LT 

[0 0 2 1 ] #$gBj3£&©fg 8 ©^atfcs iHjBB#fPJ3;S 
*£©§! 7 ©«f»C*»*ffif|B» 1 ©MUM** 5 , iulBv^ 

©#tf£tSflifc:;fcSo 

[0 0 2 2] *«W*ffiO* 9 ©^S&fcfc, fl&ffi#*lUl# 

mmmmtK n^titzmmm^m^m^t, mm 

ll«©**Jfc0l« 5M©1^ i: ©¥ 

*B8«**Jffl IT, ItS'J Lfc*jf*©l6^fHR*#K>T:. 

[0023] *&wftm<Dm i o ©^a«> «oib*«w 
^^©^9©^at*5WSMi3^s5^A s s ute, ae 

35iS©»fi8Sfli efts, 
[0024] jzftmftmam 1 1 ©«r»«u buib*%bs 
;5&©gi 9 xtem i o<Dft»£.t$tt&mf2m2<Dmm8. 

[0 0 2 5] *»W^*©S6 1 2 ©«r«{±, fuI3*^B^ 

jsm<Dm9, mi oxii»i i<o«F«cd3»sfflHaa6ip 

t){*©^fc|B!«tc, iuHBvnbrj.U'-<S'©jIt!jtf$8i: 
BUBB-fe >1ttC «fc Stf-SO^lCT BUBBLE ^ )VmW(Di%^.£ 

l t »t st * »«35g& » * m ornmmm \z $> % „ 

[ 0 0 2 6] *^B^*^©^ 1 3 OftMIZs mnttftw 

i5&<Dm9s no, mi lxtissi 2©^a{-*5»t-s 

mJBB^2©{f$Ifi*^ HuBB^-fr^iJOXD^v; hCTiPX 
•TStC^tl, ^KJDXDTjf s» h©fuHBM*^^-r?.T7" 
D - tt£ffl H «t V 7- 7* □ - j$Jg ©^ t Wffl L X ft 2> 

a«5i« »^ m {- s o 

[0 0 2 7] *^B^^ffi©^ 1 4 ©#gK«, ituB3##gBJ3 
*«OSBlx ^2> SB3, SB5x S6, fli 

8, 19, 110, II K 112 Xltm 1 3 ©#atc 
*3WSB(IfBHr>-y-* s , U— tf— \s>i>-b>-y-X$>Z>Vo#. 

[0 0 2 8] *^B^^?S©I l 5 ©^a«> bKI3*«93 
£i£©»l, ^2, ^3, *4, ^5, ^6, ^7, flS 
8, ^9, 110, 111, 112, mi 3Xttfl5l 4 

{*ttB^»^?£©«5KSffl 5 o 

[0029] *«ra*a5©« 1 6 ©^a(±, mttt&w 

M©I1 5©^atjoW^tfH3-b>^S!!»A s , BtfaB 
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[0 0 3 0] #3P.B^©g? 1 ©ft««\ «9{*©tt«g|S 
{££*>^^ShbTlt$Jir £-fer>-y-i:, !^-te>-tJ- 

■y - C =fc & itffii^ « i: m IB v = t i b - * ®9M W IS fc a 

[0 0 3 1 ] #3*B,g=gg©g§ 2 mJBB*^B^^ 
B©fgl©#^^3ituI3itl«SA\ Bul3-lr>-y-i:Su 

tu^ffi tte^tz£» mmm* ^vizxtktti^mx-$>^ 

tz suIB-fe >-9-«ftS*3&««a RTtfei: «c o fcj** iffilBfttt© 
SgjShbT^jeu ji9gB»f*©flmSS»S««-f3SW 

[0032] m&wmm&m 3 busb*^b^^ 

M©m lX(±^2©^mt*WSH5aBtf-»^A s , miSBv 

wsot* l * *a-r* i ©ft «js*»ai-f 

[0 0 3 3] *&Bf}m&<Dm 4 <0ft«t± x ffi8B**g3B£E 
S©SBU ^2X«i^3©!Rfmtc:^{t2,Bus31t*:«* J . 

©ttfc£0i]SK*to©{fiM18S^£©5i*»e> b££*-T 
SS 2 <DttlK«&ff til? *#ftfig&4f LT«t S«J*ffi«i*K> 

[0034] *^b^^s©^ 5 commit, ma*fNm 
mom is i2, *3xtt*4©«at:*jtt4«ri3-b> 



[ 0 0 3 5 ] 

[ 0 0 3 6] ($H0g) H 1 tt*%BJ»c^S^g0iJ©^l 
*(ftB»l»*«a<Z)fltj«4^-r« PIBIt^tat), 
«0<l©fMt:{fiEBifeft8«a«\ x'^tfiU-^ 1 % ^E- 
->3>^>hD— 5 2, v- U — * 1 (Cfgfg^tlfe 
10 lflffl-b>t3, •b>-9-3>hn-7 4, Tztab- 

-*l©lt»«ft : E = ^t5^V3>PCl, SSUE 
*J»#J&©^>K5, 7©gaBHHr>-9-3> ha -7 4 

£&+*tu-*vi vn >p c 2 n*o 

[0 0 3 7] 1HU 6gft«m t 

— >>3 >3 > h D — 5— 2 £T$!WB)&*V3o ^E— v- 3 > 

3 K-rtftmr e> 

[0 0 3 8] -fe>-y-3tt, }fe$0®rMU — tfbV^-te^it 
T-feoTs U— AS— JtttB£«lRllS8iJb*r7 — 
? Wjjp 6©SS*3te*S* UT=£3IJS©J!3IT"7 — £W 
h ®^©t!6*s 0 ;5|r| fc*fr&35fil© 2 g fflg©Sggi£il- 
fflij-f 5 o "7 — * W©3i y ^gp^-tr -fe > 3 * s (ug bfc» 

[0 0 3 9] 

[*m 



■t >- # & m m m & r s (o s r, ^ 1) a* ^- ^ tt 5 „ 



1U ^©^«,ffit?3>7"7-f TVXld 1 ? — i7 

W&ffl8fT?S4t>«DT*So ^> F 5, 7tt, v^fcfi 40 
U — ^ l©fife{c^^-v3>6tc:t.KMW6n, 9-^ 

[0040] ^ic, vmiM*m.mvttb&wa 

[0 0 4 1 ] DftSttiPi] 5feTx imT-:?l:l^ut 
^e— >-3>3> hn— 52*^v- fib— ^ i^uf^$ 

1 ©rtW-b >+*-*^©^>rj-^tf IBSWfi0^gtf$B(c 



[0042] Ymmmmits ytva>pc 

1 t $ n fz 2 S © h 5 > X fcT i - * T R P 2 X V T 
RP 3(cteiH^tv-5o l^t, >-?Vn>PC2©CPU 
iiSCS I §/t'bT-fe>1^3 > h D — T7 4 (^SjRStti 

;<V3>P C 1 ±© h5->X ta-^TRP 3CD 
h5iteti#HIX»©fc#>©gAR£ffi-ro 
[0 0 4 3] btv ;iva >P C 2 (-T-b>it^a 

©&M&*6£fj a. 
[0 0 4 4] &i5, *'>7f Atll v--^ib — ^1 
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£ mmo * > -y- 3 £ 4 o m h n tz * > mmm® * 
>v¥smmifi mrnrnm t 4 s *g*f&fipi& t g& 

b\ * >-tn$am©#©«^f4#j msec, mnyhcDm 

»«IB©^©^tt^32msec, -fe d# y Y-'M 

>PC2©CPUi:-b>1^3, h7>^ti-^TRP 

[0 0 4 5] [SfflUiB^] m 2 fcfc*J<*ffifift 
&S?-^W©-0iJ£^b;fcfc©T'&So V — fVHDB 
ttttx -fe 3 C J; 5 Wffifr3!'jRJtg&x ->* E U 

So *>^>^£4!3 3©^©i£^#9— ^W©ffij& 
P-h bTl&f±i£tiSo 

[0 0 4 6] B3tt>7-*©W«eB#**#fl«>fctfetti-f 
SFD-LD&t^UT^U 12 4 14 F D - L D 
*Tl-Sfc#>©T.;i/mjXA©:7a — $r^-fo "7 — ^W© 
ffl«jS»*l|tm-r4t:^Dx M£fr©^£T-^to2R#)fc 

S*titBicBfr*ifc7-*w©^a^#£#Bf5^;i'£: 

- * W ft «J5K 1" S x u> v E © P « i: f S a 
[0 0 4 7] «#Hc. t? a u-* i {±, -fe 
*p.*tftau«Ev^(i«fc:-b>-y-3*^i(»u ^©^9 
— w©x. u; ^ e £*e o t -fe > -y- 3 -fr s o 

[0 0 4 8] ^y^E©m^ffi«M-iSt:-lr>-y-3 4»*S 

rat-tr 3 ifi&m-rzt ««jt«w*nfe-b >it 

OSS^FD (First Detection) &£:n¥-£;r htc-f 

[0 0 4 9] £tz, v^tTib — # 1 £^46>7-^Wffl 
x. y i? E ± fctfcBtttt T*5§s -fe > If 3 #-fe >-^^SSa 

£#»)£^s£?£fcqrf&-T:-;&So c©4^(3-fe>-y-^ 

Elfflfc-fe>1*-3;W£«rf *»fc«ffi*lifc-b> 
©75&£LD (Last Detection) ?Si:D?^ci i: iz? So 

[0050] j2h±bmii Lfe f d - l d mx-it, -b >+H8 

SStS©tfctB©WS©<frT- WCD«g£&BUI LT«Rrj£ 

[ 0 0 5 1 3 ±a ufc f d - l d m<onn m 4 
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i:^tioC, 5fct\ ^V3>P c 2 tcT-b>-t)-n> h 
D-74^Lt-fe>if3*WbU (ST 1) , -tr> 
v>^£?T?frgfr (ST 2) \ -fe>-y-3©b— tf*s^- 

>^g*^ (st 3) mmzti&o LT> -te>*>>^& 

frto&^»£fcttU--y#:*7fc»i£3ft (ST 4) % 
■fe > 5> > ^£*t 5 K (4 U— tf a** > ClftjS;* *XS 
(ST5) o 

[0 0 5 2] ylvrj>P C2(4-b>-t)-3> hn- 

10 M4M (ST6) bfcgU ^V3>PCl±(:n# 
y h31Iftti*gStf#©fctf>©B5f<£:itibs D^iy hSlbtS 

ffi (m&mwifim ^rot-r-s (st7) 0 *lt, * 

VZJ>PC2(CT-b>^afitD#^ h^iiSttlB^ffi 
^T, (ST 8) , Z.fi^ 

-*lZffiWi-%> (ST 9) o 

[0 0 5 3]g|V^T, FD-LDi&ffiUfe9-i7Wffl 

©^n> H 7 C4 t> C — ^W*sSip(4BT-@^^tl-54d 
20 l:U ^©a^fiBT-H^^ftfc 1 ? — ^WCfcfLTJiia 
FD-LDaEtC«tt) C-^W©«^§ 3 ^W±^ttSRTIE 

f^^nfc 1 ?— ^w©sgj^s^7=;i/P„. 1 (i = 

1,2, n) tUSfttS. 
[0 0 5 4] (b)9-^W©{tt*§.'U' s» h«4^»»A$ 
tli>t)©i:L> tfa 1/-^ 1 (O^^U ;/ b it 

S 4 5 tSl^ LT*5 < o 
(c)^-tri b — £ 1 >^ h fr<b 9-^W^g£ 

^Jg©^>h'5iC4t)JE^bfc^ X^-^a>6±i 
30 tv- tTiU — ^ l©^$fcteB*s^i&t-5 4^(3^L 

[0 0 5 5] (d)^r->3>6±©«I^-evz 

uu— ^t, miz, 7,^— 3 > 6±©sgaa^^l©/^ 

C 4 ») if © 4 ^ £ BJ££ tlfc A^4 d ©KP&T- I4*J31 f & 

^>0 <^ N 

40 [0 0 5 6] (e) J E5 s ;u*»fc(Oi:fii««eaw«B-cv 
^tTo.^-^ 1 ttfeMis, FD-LDSCJ;t)7T-i' 
3 > 6©iFLffl?g*{CH^$nTl>-5 , 7 — ^W©«7— ?Sg 

,sp«, j ( j = 1 , 2 , n) ^m-r^o ht> 

<,>©-£> t^tti^tl-Sy — ^WCSjSCIiv^tal/-^ 

1 ©^ttMS v fcflc# b fe^tBi^M* s ^ b So 

[0 0 5 7] 0 5t49-^«.^tB(2B.i:^-trjLU- 

h m s 4 a \z s v ©tiiD t# ot«mu fe^a^s© 

50 tf6o«fli«'b<«:«. ^^T% R«©*fc0t? 



(7) 



1 0-8 9 9 4 3 
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Krv.x^SC (1) 
CO 0 5 8] 
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(0^r v ^l) 



(1) 



1 ] 



[0 0 5 9] 
r s ,k 14 k # @ © y - # W<D 



& £ *5 n 

2 



[0 0 6 0] 



^ ^ -c . 
(>o) i4ifSS#t-efc5„ 

* * [^3] 

t L T #J -f 5 o 
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